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Abstract 

This work is concerned with the control problem 
of a multi-robot system handling a payload with un- 
known mass properties . Force constraints at the grasp 
points are considered . Robust control schemes are pro- 
posed that cope with the model uncertainty and achieve 
asymptotic path tracking. To deal with the force con- 
straints, a strategy for optimally sharing the task is 
suggested. This strategy basically consists of two steps. 
The first detects the robots that need help and the second 
arranges that help. It is shown that the overall system 
is not only robust to uncertain payload parameters, but 
also satisfies the force constraints. 

Keywords: Multi-robot systems, unknown payloads, 
robust control, adaptive control, force constraints. 

1 INTRODUCTION 

The range of tasks that require anthropomorphic 
manipulation motivates the use of multi-robot systems. 
In particular, tasks that require manipulation of a sin- 
gle heavy load or a cumbersome object could exceed the 
force and work envelope limits of a single arm. One of 
the major issues involved in a multi-robot system is to 
coordinate all the robots so that they perform a given 
task in a cooperative manner. More specifically, the 
control problem includes dynamic behavior modeling, 
trajectory tracking control, internal force control and 
task distribution among the robots. 

Although still in its early stages of development, 
there has been significant progress in this area, and a 
great deal of work has been reported in recent years. In 
the area of modeling, the work by Luh and Zheng [14] is 
among the earliest research dealing with the kinematic 
and dynamic constraints imposed on such a system. 
This was also studied for a two-arm system by Suh and 
Shin [28]. 


The dynamics model of a multi-robot system is re- 
quired for the development of control algorithms. As 
has been reported in the literature, the dynamics model 
of a multi-robot system exhibits its own inherent prop- 
erties. Hayati [9] investigated a dynamic model for a 
closed-chain system. This issue, together with the con- 
trol problem, has also been studied by Tarn, Bejczy and 
Yun [29], Furuta, et al [8], Ozgiiner, Yurkovich and Al- 
Abbass [18], Yun [35] and Li, Hsu and Sastry [13]. 

The work by Cole, Hause and Sastry [6] considered 
the case of a multifingered hand in rolling contact with 
an object and both the kinematics and control issues 
were investigated. Alford and Belyeu [2] studied a 
two-arm system and proposed a leader-follower control 
strategy, which was generalized to a multi-arm system 
by Arimoto, Miyazaki and Kawamura [4]. A position 
and force control scheme for a multi-robot system was 
proposed by Nakamura, Nagai and Yoshikawa [16]. 

Issues related to force distribution in closed kine- 
matic chains were discussed by Orin and Oh [17]. Al- 
berts and Soloway [1] suggested a control law which 
distributes force among the manipulators by using a 
weighting function. In the work by Salisbury and Craig 
[21], Yoshikawa and Nagai [34] and Nakamura, Nagai 
and Yoshikawa [16], the force exerted on the object is 
distributed based on an object-related criterion. Zheng 
and Luh [36] developed load distribution schemes for 
two-manipulator systems which were based on minimiz- 
ing either the system energy or the force imparted to 
the object. In those schemes, the manipulator’s dynam- 
ics are explicitly considered. Anderson and Pittelkau 
[3] proposed a load sharing force controller that ap- 
portions control forces between two manipulators. An 
adaptive algorithm that uses a joint torque-based cri- 
terion to determine the optimum load sharing was sug- 
gested in that work. 

By considering the effect of loading on the dynam- 


ics constraints, Walker, Marcus and Freeman [32] pre- 
sented an approach for load distribution. The reac- 
tion forces created by a given arm’s input loading was 
considered in Unseren and Koivo [30]. Carignan and 
Akin [5] derived the torques for two planar cooper- 
ating arms. A coordinated control law for a multi- 
manipulator system performing parts-matching tasks 
was proposed by Hsu [10] and a decentralized structure 
for the control strategy was suggested. In a recent work 
by Walker, Freeman and Marcus [31], the motion and 
internal loads induced on an object grasped by two or 
more robotic manipulators were analyzed and the load 
distribution problem was formulated by using the non- 
squeezing pseudoinverse. 

In the context of controller design, two approaches 
are generally used. In the first, the problem is simplified 
by implicitly assuming that the payload information is 
known exactly and can be precisely modelled. In the 
second approach uncertain payload effects are compen- 
sated by the use of a wrist force sensor (see references 
[3], [9], [19] and [29]). In general precise information 
about the payload is not available for many applica- 
tions, and the force sensor method depends heavily on 
the precision of the force measurement, as has been 
shown in [3]. These facts motivate the study of adap- 
tive control schemes for multi-robot systems. 

Mo and Bayoumi [15] proposed an adaptive con- 
trol method for a multi-arm robotic system by using 
a method similar to that in Craig, Hsu and Sastry [7]. 
Walker, Kim and Dionise [33] reported an adaptive con- 
trol strategy that accounts for payload effects. Hu and 
Goldenberg [11] also investigated the case of uncertain 
parameters in a multi-arm system. However, in most 
of these strategies the force constraint problem is not 
considered. 

In a recent work by Song and Anderson [23], a new 
adaptive control law with a colleague-like strategy for 
task distribution was reported in which the force con- 
straints are explicitly considered. As an extension of 
and a complement to that work, this paper is devoted 
to the robust controller design for multi-robot systems 
with both unknown payload dynamics and force con- 
straints. First, following a modeling procedure similar 
to that in [6], a combined dynamic model which ac- 
counts for payload effects is derived. This model is 
slightly different in structure from the one obtained in 
[6] as a result of considering the forces and the moments 
exerted on the object. New robust control algorithms 
that explicitly deal with unknown payload parameters 
are developed. By using the generalized energy accu- 
mulation method, it is shown that the control strategy 
guarantees asymptotically stable path tracking of the 
payload’s mass center. A strategy for task distribution 


is suggested which considers the dual contributions of 
the control torques. That is, it not only produces the 
control torques required for path tracking, but also sat- 
isfies the force constriants, a necessary condition for fine 
manipulation of the workpiece. 

The main uncertainty in practice is due to the pay- 
load, not the robots themselves. Thus the attention in 
this paper is focused on the uncertain payload the 
most significant effect on system performance (Leahy 
[12]). However, the technique presented herein can be 
readily extended to the case where uncertain parame- 
ters exist in both the robot and payload models. 

The remainder of this paper is organized as follows. 
Section 2 presents a derivation of the combined multi- 
robot/payload dynamics model based on the funda- 
mental equations presented in the first part of the sec- 
tion. The structural properties of this model are inves- 
tigated, and are utilized in Section 3 to develop robust 
control strategies. Tracking stability is analyzed in Sec- 
tion 4, and a new robust control which does not rely 
on norm bounds is proposed in Section 5. Task distri- 
bution among the robots is discussed in Section 6 and 
a strategy for optimal sharing of the task is proposed. 
The application of the strategy is illustrated in Section 
7 by means of a three-robot example. Comments and 
conclusions are given in Section 8. 

2 MODELING 

A dynamic model for a multi-robot system handling 
a workpiece was developed in [23]. However, due to lim- 
ited space, many important details were omitted. For 
completeness, the modeling process of [23] is expanded 
in the following. 

2.1 Kinematics 

The multi-robot system illustrated in Figure 1 rep- 
resents several robots handling a common payload. For 
simplicity, it is assumed that each robot has six degrees- 
of-freedom. The first joint of each robot is attached to 
a fixed base and the i th robot is grasping the payload 
at the contact point Q. Rigid grasping is assumed 
such that there is no relative motion at the contact 
points and there is perfect force transmission between 
the robots and the payload. Also each contact point is 
fixed and has a known location on the payload. Each 
robot applies a force f c% and a moment n c% through 
the contact point C* to the payload. There are totally 
d(d> 2) robots handling the payload, and the payload 
lies within the combined loading capacity of the robots. 

The Cartesian coordinate frames shown in Figure 2 
are defined as follows: 

{Fj} is the inertial reference frame. 

{F p } is the frame fixed at the payload’s center-of- 


mass. 


Figure 1: A Multi-Robot System 


Figure 2: Coordinate Frames 


{ F \> . } is the frame fixed to the base of the « th robot. 

{ F Ci } is the frame attached to the i th end-effector 
at the contact point C*. 

According to Chasle’s theorem [22] from elemen- 
tary mechanics, the motion of a rigid body in world 
space can decomposed into a translation plus a rota- 
tion. This is referred to as a rigid motion by Spong 
and Vidyasagar [27], Six parameters are required to 
describe the position and orientation of the rigid body. 

At the contact point C» (see Figure 2), 

x Ci = x 0 + tfpC, + C 1 ) 


the frames {F p } and {F/} have the same orientation. 
However, since R £ depends on 4 > o = [<£oy> ^op> ^or] i 
the yaw, pitch and roll angles of frame {/>}, respec- 
tively, it is generally not true that R £ = £3 the 
payload undergoes rotational motion. Hence, in the 
following, a time varying is considered. To simplify 
notation, R is used to denote Rj, in the following 
As can be verified, the matrix R has the property 
[27] 

R =. u?o x F, (3) 

where 


w Ci = w 0 , ( 2 ) 

where 

di is the vector that locates the origin of {F&.} rela- 
tive to {£/}, 

d is the vector that locates the origin of {F Ci } rela- 
tive to {F p }, 

x 0 = [x 0 *,X 0y ,X 0 ,] T “ a vector in i F f) l° catin g the 
mass-center of the payload, 
wo = [woy, wop, wor] T is the angular velocity vector of 
{Fp} in terms of the yaw, pitch and roll rates, 
w C| is the angular velocity of {F c .}, and 
R f is the rotation matrix which maps c*, measured 
in frame {F p }, to the reference frame {Fy}. 

In much of the literature, it is implicitly assumed 
that R* = F 3 G F 3 * 3 , a unit matrix. This is true if 


w 0 x 


0 — W 0 p Wo r 

WOp 0 -W 0 y 

— w 0r W 0y 0 


Differentiating (1) and noting that d+ and c, are con- 
stant yields 


x Ci = io + R c i 

= Xq + Wq x Rc{. 


( 4 ) 


Since u/o x Rci = -(Fci)xu/ 0 , (2) and (4) can be written 
as 


F 3 -(Rci)x 

0 £3 


, x 0 

1 

|Wo 


± 5, 


Xo 

Wo 


(5) 


Si = 


( 6 ) 


where 

E 3 — (72c*)x 
0 *■ £3 

In the task space, the position and orientation of the 
i th end-effector can be represented as 

^ 

“ [^ctr ) ® ciy » x ciz , 4* ciy j ficip , 4* cir ] (7) 

where <f> c i is composed of the yaw, pitch and roll angles 
representing the orientation of the i th end-effector with 
respect to {£/}. In joint space Pi can be expressed as 

Pi = *(#), (8) 

where qi £ R e is the generalized joint displacement of 
the i th robot and P t (.): R 6 -*■ R 6 represents its forward 
kinematics. Therefore, 

A - 

dPi(qi) 


dqi 




Since 


where 


(jJa — 'Pciijfrciy >4*ctp y4cir) 


4>ciy 

4>cip 

L 4 eir 


TM = 

then using (5), (9) and (10) yields 


— Sin <f>ciy COS $cip COS $ciy 

cos <t>dy cos (f> cip sin <f> c i y 
0 - sin <f>dp 


Si 


*o 

U)Q 


— JiQii 


(9) 


(10) 


( 11 ) 


( 12 ) 


where 


Ji = 


dPi(qi) 


dqi 


(13) 


\E 3 0 

9 ^Ci(^e»'y » 4dpi ^cir) , 

is the generalized Jacobian matrix of robot s. It is as- 
sumed in the following that each robot works in a non- 
singular region. Thus the inverse of Jj exists. 

Considering all the robots that act on the payload, 
(12) can be expressed compactly as 


Jq = S 


xq 

W 0 


where 


J 

S 


A 

A 


blockdiag{ J\ , J 2 , . . * , Jd} € iZ 6rfx6d , 
[5 ? * SZ...Sj] T €R 6i * 6 , 


A r T T TiT oGd 

q = [?! q 2 • • - q d ] € R 

Since the forces {fci, fei, ■ ■ ■ ifed} and moments 
{n e i,n c2) ...,n C( i} act on the load, the equivalent force 
and moment applied at the mass-center are 


and 


respectively. In matrix form, (15) and (16) become 


fd + fc 7 + ■ • • 

+ fc 4 


(15) 

n Cl 4* n C3 + • • 

. + n C4 + (Rc 1 ) x f Cl 


+ (Rct) x fc 2 

+ ... 

+ ( Rc d ) X f Ci , 

(16) 


r/oi _ r *3 ° 

[r»o [(Jlci)x £3 


F 1 + 


E 3 0 
[(£c 2 )x £3 


+ ...+ 


f ft 0 1 Fd 

[(£c d )x £ 3 J 

= WiFi + W 2 F 2 + . . • + W d F d 

= WF, 


(171 


where 


* = [»;,]■ 

w = [Wi w 2 


Wi 


E 3 

[(£c,)x 

,W d ] € R 6x6d , 


0 

E 3 


and 


F = [F? F]' ... Fj] T € R ed - 


Concerning the matrices W and S, the following prop- 
erties hold. 

Property 2.1 

( 1 ) S and W are full rank, i.e., rank(W) = rank(S) = 

6 . 

(2) Both Si and Wi are nonsingular, i = 1, 2, . . . , d. 

(3) S T = W. 

The proof is similar to that given by Song and Anderson 
[24]. 

2.2 Motion Equation 

Suppose that the mass and the inertia of the payload 
is m and 7 q, respectively. With the action of / 0 and n 0 , 
the payload undergoes a rigid motion in the world space 
as described by 

/ 0 = mx 0 -h mg (18) 


(14) ^ 


no = RIqRFujo ■+■ wo x RI$R wo, (19) 
where g € R 3 is the gravity vector. In view of (17)- 

(19), 


*0 

wo 


+ 7^2 


Xq 

Wo 


+ P3, 


and 


WP = V\ 


where 


where 


i 


and 


V x = 
P 2 = 

^3 = 


77% E 3 0 

0' Rl 0 R T 

0 0 
0 wo x RIqR t 


mg 

0 


(20) 


'0 

— sin <f>Qy 

COS (pop COS (pQy 

To(-) = 

0 

cos <j6oy 

cos pop sin <poy 

1 

1 

0 

— sin (pop 


( 21 ) 


it follows that 



Xo 


'£3 

0 ' 

Xo 

(22) 

Uo 


0 

To. 

m <pQ m 



= AX o, 




(23) 


(24) 


The reactive forces and moments of the payload 
appearing at the i th end-effector are represented as 
Freacti • Under the assumption of rigid grasping at the 
contact point, 

Ercartt — i > 

which causes the joint reaction torques 

T Frmmc t; = (oi^reacti 

= -J?(qi)Fi. 

So for each robot it follows that 

Hiii + Ciii + Gi = Ti + T Fr „ ci .number (25) 
= Ti-jfFu i = 1.2 (26) 

where, for the i th robot, is the inertia matrix, 
is the vector of centrifugal and Corolis forces, Gi is the 
vector of gravitational forces and Ti is the vector of 
control torques. Defining 

H = block diag{#i, H?, .. .Hd] € R? dx6d , 

C = block diag{Ci , C 2 , • • Cd} € # 6dx6d i 

G = [G\ G?.. .Gj] r eR ed , 

and 

T £ [rj tJ . . . tJ] t € 

the combined form of (25) is 

T = Hq + Cq+G + J T F. 


( 30 ) 


(27) 


This model can easily be transformed to the task 
space. From (14) 


x 0 

Wo 


q =s J _1 S 

Noting that 

UJq = ^o(^Oy j ^Op > ^Or) 


= To^o, 


(28) 


<i^0y 

$0 p 

‘/'Or J 


where 


and 


vl = 


£3 0 

0 To 


eR 


,6x6 


X 0 


= [ 2 ]- 


Notice that det(T 0 ) = - cos 4> 0p . For small changes in 
the payload’s orientation (|4» 0p | < §)> the matrix A is 
invertible. Now by (27) and (29), 

q = J" 1 SAXo (31) 

such that 

q = J -1 Sj 4X 0 + —■(J“ l Sv4)X’o- (32) 

In view of (20)-(22), (26) and (29)-(31), the com- 
bined dynamics of the multi-robot system through the 
payload may be written as 


WJ~ t T 


(29) 


= ^WJ -T HJ -1 Si4 + ViA^j Xo 

+ (wj- T Hj t (3- 1 SA) 

+ WJ" T CJ _1 S^ + Vi A + V 2 a) Xo 
+ WJ -t G + X> 3 . (33) 

It turns out that the combined model is somewhat “ir- 
regular” in that the well-known properties applicable to 
general robot dynamics do not necessarily hold. That 
is; 

1. the generalized inertia matrix WJ“ r HJ _1 SA-f 
F)\ A is not symmetric, and 
2 r the property of skew-symmetry is not valid. 

Remark 2.1 

The fact that the generalized inertia matrix is not 
symmetric positive definite makes it difficult to di- 
rectly use the Lyapunov method to verify stabil- 
ity. The passivity principle also cannot be directly 


1 m 


applied because the property of skew-symmetry 
does not hold. In the next section, a simple trans- 
formation is applied tjo “regularize” the combined 
model. 

3 ROBUST CONTROL METHODS 

3.1 Control Objective 

As previously noted, it is generally difficult to know 
the payload’s characteristics precisely. For this reason, 
it is assumed that the mass m and the inertia matrix Iq 
of the payload are unknown. The desired path is given 
in terms of position and orientation as 



The tracking error is expressed as 


C 0 = A T WJ“ T H(j -1 S/l + J _1 Sj4 + J -1 S,4) 

+ ^ T WJ- T CJ _1 S^, (38) 

C p = A T V l A + A T V 7 A 

[0 0 

[0 Tq'wo x RIoR t Tq 4 - To RIqRTTq 

(39) 

g 0 = A t W 3~ t G ( 40 ) 

and 

Q, k ^p,= [7]. (4D 

For this model the following properties hold. 

Theorem 3.1 

The transformed model (33) is regular. That is; 

(1) Ho + H p is symmetric positive definite, and 

(2) [ Ho + H p ]-2[C 0 + C p ] is skew-symmetric. 
Proof: 

(1) The first property can be shown easily by using the 
fact that 


e = Xo-Xt 


x 0 “ ^0 

A 

€\ 

<j)Q — 0Q ^ 


^2. 


The motion control problem is stated as: 

Design the control torque T such that the actual 
path of the payload's mass center ( Xq ) asymptot- 
ically tracks the desired path (Xq) in the face of 
unknown payload parameters. 

3.2 Model Transformation 

Due to the “irregularity” of the model (32), direct 
solution to this problem is complicated. In the follow- 
ing, a simple transformation is introduced. By observ- 
ing the structure of the combined model (32), it is seen 
that if both sides are premultiplied by A T , the trans- 
formed generalized inertia matrix is symmetric positive 
definite. Moreover, this mutiplication also leads to the 
property of skew-symmetry. After the transformation, 
(32) becomes 

[Ho + H P ]X o + [Co + C P ]X o + [?o + Q P ] = X, (34) 


where 




T 

A 

v! t WJ _t T, 

(35) 

Ho 

A 

v4 t WJ -t HJ _1 Sj4, 

(36) 

H p 

A 

aFV\A 



= 

[ mE 3 0 

[ 0 TJRIoR t T 0 \ ’ 

(37) 


W T = S. 

(2) By the definitions of Hq,H p Xo and C p , it follows 
that 


[Ho+H p ] - 2[C P + C 0 ] 

= Ni + N 2 + N 3 + AT 4 + N 5 , (42) 


where 


Ni = j4 t WJ - t (H - 2C)J -1 Sj4, 

N 7 = j4 T Wj -T HJ -1 Si4 — J 4 T WJ _T Hj _1 S/l, 
N 3 = A t WJ~ T HJ~ 1 SA — i4 T WJ -T HJ _I SA, 
N 4 = i T WJ" 1 HJ" 1 Syl->l T WJ- T HJ- 1 Si, 


and 


where 

Af 


N 5 


0 0 
0 M ’ 


j t (Tj RI 0 R t T 0 ) 

- 2Tqu>q x RI 0 R t To - 2Tq RI 0 R T f 0 


Property 2.1 ensures that the N t ( i = 1,2,3,41 are 
skew-symmetric. Furthermore it can be shown that jV 5 
is also skew-symmetric (see Appendix). Thus the result 
follows. 


3.3 Controller Design 

Instead of designing control torque T directly, the 
transformed input T is specified first. This approach 
allows the use of the regularized model and its proper- 
ties, as stated in Theorem 3.1. Section 6 introduces a 
method to calculate T from T . 

Robust Control I 

To develop the first robust strategy, the decomposi- 
tion of the transformed model is performed first, so that 
the payload parameters are isolated from the dynamics. 
To this end, the following matrices are introduced: 


Ext — R 


E.. 


xy 


E x 


jyy 


and 


= R 


= R 


= R 


= R 


Ey Z = R 


1 0 0 
0 0 0 
0 0 0 

0 1 O' 

1 0 0 
0 0 0 

0 0 1 
0 0 0 
1 0 0 

0 0 0 
0 1 0 
0 0 0 

0 0 0 
0 0 0 
o o 1 

0 0 0 
0 0 1 
0 1 0 


R 1 


R 1 


R 1 


Rr 


Rr 


R 1 


Therefore the matrix RIqR T can be written as 

RI 0 R T = R 


7(3 xr 
Toyx 

7(3 zx 


7(3ry loxx 

7()yy foyz 

lozy loxx 


R 1 


- £l>*, 


i—x j—i 


due to the symmetry of Iq. The transformed model 
(33) cam now be decomposed as 


where 


T = HqXq + CqXq 4 Go 
m(x 0 4 g) 

+ ieue;=.m,J' 


M ij — IoijTf [Eij To<f>Q 

4 (u>o x EijT 0 4 EijTo)<j*o\. 


(43) 


Based on this model, a robust path tracking control 
scheme is developed. 

The control input (J 7 ) is designed as 

7 = 'H o [X%-{\ + 0)e-\0c} + Co[Xi-l3c) 

+ (45) 

where p > 0, A > 0, and K = I< T > 0 are design 
parameters (affecting stability, speed of response and 
disturbance rejection properties) and m and Iq are com- 
puted by 


(46) 


and 



Iqxx loxy Iqxz 

7o = 

7o xy ^Oyy ^Oyz 


_ 7oxz loyz Iq zz . 


tf m m 2 

m = - 


T 

QiVxxiZxX 

*0xx — 

^xx I A)xx 4* ^ 

j 

^'fxy/oxy 

LQxy — 

1^2 ^xy|/oxy + v' 

f 

*T*xx/ 0 2 xz 

iQxi — 

i^2 $ «l^0xz +»' 

f 

^H^yyfoyy 

iOyy — 

|7oyy + V 


*?<Mo 2 yz 

lOyz — * 


f 


*0 zx — ‘ 



(47) 

(48) 

(49) 

(50) 

(51) 

(52) 

(53) 


In (44)-(52), m and I 0 ij are the upper bounds of m 
and I oi j, respectively, 




= *q — (A + /?)ei - A/?£i + g 


Va = Ta 


'(EijTolit-i A 


+ 0)^2 ~ A/i£2] 


(44) 


+ [w 0 x EijTo + Eijf 0 ](ii - As" 2 ) 

= £i + 0 Ei, * = li 2 , 

* = [*f,*3'] T 

and v > 0 is a design variable that satisfies 
/ i/(r)dr < Cq 2 < co. 

Jo 

Robust Control II 


(54) 


(55) 

(56) 

(57) 


( 58 ) 


For brevity, let 


2i = X* - (A + 0)i - A/fe, 
Z 2 = X$ -> 

and 

L = HpZi+CpZi + gp. 
The control torque is specified by 


T = 'HqZi 4* CqZ2 + £o “ H* (59) 


and 




where 77 is defined by 


$77 2 


(60) 


l|W P ||||2i|| + ||Cp||||2 2 || + |M 

< a:i||2|| + a^ll^ollll^ll + «3 

= rj. (61) 

In (61), the a, represent upper bounds on the model 
norms. 

The proposed control strategies lead to the following 
results. 


Theorem 3.2 

Consider the multi-robot dynamics (33) in which 
the payload parameters m and 7o are unknown 
a priori. If the control input T is designed as in 
(44)-(57), the payload then asymptotically tracks 
the given position and orientation, i.e., Xq — ► Xq 
and Xq — ► Xq as i — ► oo. 

Theorem 3.3 

Given the conditions stated in Theorem 3.2, if the 
control input T is specified as in (58) and (59), 
then stable path tracking of payload is ensured. 

4 STABILITY 

Stability can be proven by the following result (see 
[25] for more detail). Consider a dynamical system 
£(£,£) with £ G K 1 being the system state. Defining 
the generalized energy function of the system as 

E(0 = ?KS, (62) 

where K G R nxn is a symmetric positive definite ma- 
trix, leads to the following result. 

Theorem 4.1 

Let Ja be the integration of the generalized en- 
ergy function E(£) over the time interval [0,<], 


i.e., Ja = Jo E(O dr ' Suppose £ is uniformly con- 
tinuous. If Ja < Co < 00 f° r * € [0,oo), then 
the system is asymptotically stable, i.e., £ — ► 0 as 
t oo. 

This result can be shown by using Barbalat’s Lemma 
[20] (see [25] for details). 

The interpretation of the above theorem is that the 
system must be stable if the accumulation of the sys- 
tem’s energy over a time interval of infinite length is 
finite. One advantage to this approach is that it is 
fairly easy to choose a suitable energy function. (An- 
other advantage is discussed later.) In the following, 
this result is used to prove the tracking stability of the 
proposed strategies. 

Proof of Theorem 3.2: 

Note that if the control input in (33) is designed as 
in (44), the closed-loop system dynamics is given by 

K$ = -(7fo + «p)(* + A*) ~ (Co + C p )4> 

(m - m)$ m 

To simplify notation in the following, let H* = T~io + 
Up and C* = Co + C p . As can be seen, there exist 
several generalized energy functions for this problem. 
For example 

£j($) = 

E 2 ( A,S) = A <b T H m $ (VA > 0) 
or 

e 3 ( a,$) = + a$ t /t<i> (va>o). 

In the following only Ei^) is considered. Clearly 



Ja = 


f Ei($)dr 

J o 

= / <b T K<f>dT 

Jo 

= - I $ T E*($ + A$)dr- / d> T C*<I>dr 

Jo Jo 

+ [ (m - m)$J'If m dT 

Jo 


Noting that H* is symmetric positive definite, it can 
be shown that 

A f * r H**dr > 0 (VA > 0) 

Jo 


and 


J* $ T tf*<ldr > -1* T JT* | ls0 -1 jf <S> T H'*dr. 

Using these relations yields the inequality 
Ja < Ch+ f (rh-m)$l* m dT 

Jo 

+ EE /Vo ij-hij)*l*ijdT 

x-z i=i Jo 

+ - f * t (H* - 2C*)$dr. (63) 

2 Jo 

where Ch = |* =0 . Due to the property of 

skew-symmetry, J 0 * $ T (H* — 2 C*)$dr = 0. Employing 
this and the bounds on m and Jo, (62) becomes 

ft 

Ja < Cox + / 

Jo 

^ ;=< ^ 

< Cqi + / 

Jo Jo 

+ ES / ( 64 ) 

^ 7o 

Inserting the algorithms (46)-(52) into (63) and con- 
ducting a little manipulation yields 

Ja < C ol + J o |$ T^ m| ^ + / r 

,ff [* Miajjgifl Jr 

Jo l$? Uoi j + v 

» — x 7—» 

< C 0 2 i+ / * /dr + X)S / 


Since y satisfies (57), 

Jyt < Cqi + 7Cq2 < °°> 

which implies that $ £ L 2 . Furthermore, by making 
use of the same argument as in Song and Middleton 
[26], it can be shown that $ £ Loo and $ £ Loo- Hence 
<$ is uniformly continuous. By Theorem 4.1, $ — ► 0 as 
f — ► oo. Since $ = £ + Ae, the result stated in Theorem 
3.2 is obtained. 


Proof of Theorem 3.3 

In this case, the control law (58)— (60) yields the 
closed- loop dynamics 

(Wo + W p )($ + a*) + (Co + Cp)$ = -K* + U a — L, 

where L is defined as before. Following the same pro- 
cedure as in the proof of Theorem 3.2, it is seen that 


Ja 



$ T K$dr 


< C01+ / $ T [U a -L]dr 

Jo 

< C&+ [ $ T U a dr+ j ||$||||L||dr. 

Jo Jo 


Substituting for U a from (59) and noting that ||L|| < r; 
(see (60)), yields 


‘ Hi H V.dr + 

ll^ll r 7 + v Jo 


Ja £ C^o, — J 

Jo 


/ ll*IM» 

Jo 


< Cqi + 


11*11*7+ ^ 

f udr, 

Jo 


dr 


Since u satisfies (57), Ja is bounded and the result 
follows from Theorem 4.1. 


Remark 4.1 

It is seen that the design variable v plays an im- 
portant role in the above control strategies. It is 
required in both that v be integrable. As can be 
verified, 


where ui > 0 and v 2 > 0, satisfies such a require- 
ment if m, p and n are chosen properly. 

Remark 4.2 

It is worth mentioning that, in addition to prov- 
ing stability, Ja also provides a relative measure 
of the tracking performance in terms of transient 
and steady-state errors. This is because 4> is a 
filtered tracking error, and the quantity 4> T /\4> is 
a weighted version of the squared error. Its in- 
tegral over [<o,f] represents the accumulation of 
the weighted, squared tracking error within the 
interval. The smaller this integral, the better the 
tracking performance. (See [25] for a thorough 
investigation of this point.) 


uni! 




5 SIMPLIFIED STRATEGY 

In strategy II, the quantity 77 has to be determined. 
This is accomplished by estimating at X} a 2 and a 3 . 
Knowing the bounds on m and Iq and the formulations 
of HpyCp and Q p makes it possible to obtain these quan- 
tities. To eliminate this tedious procedure, an alternate 
control strategy is proposed. 

Theorem 5.1 

Let the control input be defined as 

~ HftZ\ 4 * CqZ 2 4 " Go “ K$ 4 " U a , 

with Z\ and Z 2 defined as before and 

U __*i 

4 n*ir 

where 

fj = di||2i|| + d2||Xo||||22|| + a 3 . 

If the on are estimated on-line via 

di = di(0) + ci I ||*||||2i||*> 

Jo 

*2 = d 2 (0) + c 2 /‘ 11*1111X011112211*. 

Jo 

and 

d 3 = 03(0)4-03 f ||$||dr, 

Jo 

where d,(0) is the initial value of a » and the c* 
are positive constants, then stable path tracking 
is achieved. 

Proof: 

Applying this strategy to ( 33 ) leads to the following. 

J A = f $ T K$dr 

Jo 

< C01 + / ll*ll(»i - $)* 

Jo 

= C&+ [ t (cn-c ll )\m\\Zi\\dT 

Jo 

+ /‘(«2-d2)||*||||Xo||||22||* 

Jo 

+ Aa 3 -d 3 )||*||*. (68) 

Jo 

To show the boundedness of Ja > the following rela- 
tion is needed, 

J' f Q f{l)djf(r)dr = \ (J* f(r)dr ) . 


( 65 ) 

( 66 ) 
( 67 ) 


Substituting for the ot{ in ( 67 ) and using the above 
relation yields 


Ja < C01 + («i -^( 0 )) / 

Jo 

- |[/ ||$||ll2il|d 


1*1111^1 ii* 


+ (a 2 -d 2 (0)) f m\\\^o\\\\Z 2 \\d 7 
Jo 

t -| 2 

- c i[l ||*III|Xo||||22||* 

+ (a 3 -d 3 (0)) 11*11* 

Jo 

-tLCH’- 


By completing the square, 


T , r , , («! -«l(0)) 2 (O2-d ? (0)^ 

Ja S L/ 01 4 - -r 


2 ci 

( 0 t 3 ~ « 3 ( 0)) 2 A r? 
2 c 3 


2 c 2 


+ = c$ < 00. 

The result follows using the same argument as before. 


Remark 5.1 

The primary advantage of this strategy is that 
one does not need to calculate the design param- 
eters ai, c*2» and 03. Instead, these variables are 
updated on-line using simple algorithms. 

6 TASK DISTRIBUTION 

What is actually needed to guarantee the path track- 
ing of the multi-robot /pay load system is the vector of 
control torques for each robot (the elements of T) . For- 
tunately, since W is full rank (Property 2 . 1 ), there ex- 
ists a matrix, 

W + = W T (WW T ) _1 6 R Gd * 6 , 
such that the total control torque T becomes 

T = J T T tnd , ( 69 ) 


where 


F end = W+yT^ + F/ 

= Fp + F/. 

In these equations, Fp is the force causing the motion 
of the payload {? is computed by ( 44 ), ( 58 ) and ( 59 ), 



or (64)-(66)) and F/ G Null Space(W) represents an 
internal force vector. A well known formulation for F/, 

F / = (Eu ~ W*WV V/i G R 6d , (70) 

has been the basis for much work dealing with load dis- 
tribution. However, it is noted in [34] that, although 
F / in (69) satisfies WF / = 0, it is an inadequate defi- 
nition for internal force from a physical point of view. 
A recent work [31] also pointed out that (69) does not 
completely define the internal loading. 

Furthermore, in practical applications force con- 
straints are generally imposed on the manipulating 
forces/moments at the grasp points due to the limited 
control energy, i.e., 

\F endj (i)\ = l^(0 + ^/>(0l<w(0, 

j — 1, . . . , d, 1 = 1,. ..,6, (71) 

where F end ,(i), F Pj {t) and F t) (i) are the i th elements 
of the partitions of F end , F P and F /, respectively, 
and are given positive numbers. Such constraints 
are also necessary to achieve fine manipulation. 

So an interesting problem is how to distribute the 
task among the robots such that the force constraints 
(70) and WF/ = 0 are satisfied. The following strategy 
provides a solution to this problem. 

First let 

fij = {the set of robots working on the task} 
fi 2 = {the set of robots needing help}, and 
= {the set of robots with spare capacity.} 

Assume fl, = and fl 2 5^ {0} an d ^3 ^ {®}- 

This implies that each robot either needs help or has 
spare capacity, at least one robot needs help and at 
least one robot can provide help. It is further assumed 
that the number of the robots with spare capacity is r 
and those robots are able to provide the required forces. 

The strategy basically consists of two steps. Step 1 
checks which robots need help and step 2 arranges the 
help. The first step uses F Pj (i) as a criterion. That is, 

• STEP la: If\F Pj (i)\ > then j G fi 2 . 

• STEP lb: The Fi j are adjusted so as to guarantee 
the force constraints (70). This is achieved by choosing 
Fi i as 

*7,(0 = *7,(0 

f fij(i) - F Pj (i), if F Pj .(i) > fij(i); 

~ {-fij(i)-Fp.(i), if F Pj (i) < 

(72) 


The second step is motivated by the following ob- 
servations. First it is noted that in order to make the 
payload asymptotically track the desired path, the to- 
tal control force T must be equivalently generated by 
the total joint torque. Thus T should satisfy, 

A t WJ~ t T = A t WF end = T (73) 

With Fjj specified as in (71), the condition (72) may 
not be satisfied. Furthermore, (71) may also cause the 
null space property of F / to be violated. Hence we need 
to seek help from the other robots. Clearly such help 
should completely compensate the load that the robot 
j ( j E ^ 2 ) cannot supply. This is ensured if the payload 
lies within the loading capacity of the robots (other- 
wise, more robots should be assigned to the task). Once 
F\ j (j E ^ 2 ) is specified according to (71), F/ k (fc E £2 3 ) 
must be chosen such that the null space condition holds. 
This is ensured if F/ k is determined by 

= - £ W ’ F !,' < 74 > 

k — k\ all j€fl a 

where F/ is given by (71). 

In helping robot j ( j E £2 2 ), there is no constraint 
on how much effort each robot in Q 3 should provide. 
Hence one generally has infinite choices for Fj k , as long 
as the resultant F/ lies in the null space of W But 
what we are interested in is an “optimal” choice for the 
Fj k . This brings us to step 2. 

• STEP 2: Determine the F[ k (i), i = 1, . . . ,6, k E £2 3 . 
such that, under the constraints (70) and (73), the cost 
function , 

MF,.) = i £ X>(OFjUO = \x T Px. (75) 

^ i = 1=1 

is minimized . In this equation , pk(i) > 0 is a weighting 
parameter, x = [ F r ki Ff^... Ff kr ] T G R 6r a nd P = 
diag[p*(i)] E R 6rxGr is a symmetric, positive-definite 
matrix. 

By denoting 

r = - £ Wjf;. e R\ 

ail >en 3 

the constraints (73) can be rewritten as 

Qx = r, ( 76 ) 

where Q = [W)b l Wk 2 • • • W* r ] E F 6x6r . Therefore, 
the optimal task distribution problem under force con- 
straints becomes 

1 T 

minimize: J c (x) = ?X 

Qx = r. 


subject to: 


The Schur formula, 


m 


LJ 

t j 

Li 



y 


P 

K3 


The Lagrangian multiplier method is used to solve 
this problem. Using i = 1, — ,6 as the Lagrange 
multipliers, the Lagrangiag function is 

6 

£(x> ") = Mx) + X) - r »] 

»= 1 

= ^x T / > x + ‘ /T [<3x-r]- 

The necessary conditions for the optimal solution can 
be found from 

£ [^x T Px] £ [i^Qx] 

<9x dx dx 

= Px + Q Tv = o 


and 


Thus 


dL(x,v) 

du 


= Qx - r = o. 


det 


gives 


where 


l J] = det(A)det(D-C7T 1 B) 
det(Q< 3 T ) = rdet[r £ 3 + A], 




» = * 1 


*r 


E B « 






IX 

L * = k i 


With a little manipulation, it can be shown that 

*r 

= £ b.bj 

*=*=1 

+ £* £ + B i B J)- 

» = *i + l 


*r 


r *- 

E* 


E B . T 

-* = * 1 


J=k 1 


*/* = — [Qi=- 1 Q' r ] (77) 

and 

X* = p-'Q T [gp- 1 Q T ]" 1 r. (78) 

Correspondingly the minimium cost function is 

K =£(*•,-•) = ir’-[< 3 P->«T‘r. ( 79 ) 

Notice that the inverse of the matrix [ QP~ l Q T ] should 
exist in order to obtain (76), (77) and (78). Since this is 
an important issue concerning the existence of the opti- 
mal solution, a rigorous proof of the invertibility of the 
matrix QP~ l Q T is worth investigating. For simplicity, 
let P = Eq v , a unit matrix. In view of the definition of 
Q, it is seen that 

QQ T = W kl Wl + W k3 WI + --- + W kr Wl . (80) 


This relation reduces A to 
* = 

-i*E Y.iB,B] + B ,BT). 

Also noting that 

(r-l)E BiBj =£ S 

»=ii i=rtij=i+l 

Vr > 1, it can be shown that 

A =-E E (S, - fi,)(S. - B;) T . 

r i=*i i=»+l 


Since 

0 ’ 

£, £ 3 J> 

where 



= (Rci)x t 


then 
Therefore 

qq t 


w k ,wl = 


Ez 

Es + Bk t Bki\ 


= [ r Ez E<=k, 

LE^*. Bi 


r&3 + Ef=*i BiBj J 


which shows that A is at least positive semi-definite. 
Therefore r£ 3 +A is positive definite and QQ T is invert- 
ible. The same conclusion can be drawn for a general 
diagonal P with more effort. Based on this discussion, 
following results can be claimed. 

Theorem 6.1 

If T is generated by 

T = J t W + A _ t ^ + J t F/, ( 81 ) 

where T is from (44), (58) and (59), or (64)— (66) , 
Fij (j G Q 2 ) is specified by (71) and Fj k ( k £ Q 3 ) 
is computed by (77), then; 


(1) asymptotically stable path tracking is ensured, 

(2) internal forces are non-zero at the contact 
points, 

(3) force constraints are guaranteed and 

(4) optimal sharing of the task is achieved. 


Fl(y) 

d 


r iso -ijr( y ) 

\-l50- ^(y) 

f 150 - \?{z) 

\ -150 


if \T{y) > 150; 

if iHv) < “ 15 ° 

if k?(z) > 150; 
if \Hz) < -1^0 


Result 1 is true because such a T leads to the equiv- 
alent control force T . Results 2, 3 and 4 hold because 
the choice for F/ satisfies (71), (73) and (77). The prop- 
erty of non-zero internal force is of particular interest 
in many advanced applications where no slippage and 
effective manipulation are required. It is seen that with 
this strategy, whenever \Fp } | > /ij(t), help from other 
robots is provided. Thus the given task is shared in a 
colleague-like manner in the sense that robots help each 
other when necessary. Furthermore, with Fi k (k G O3) 
determined by (77), the task is shared among the robots 
in Q3 optimally in that the cost function (74) is mini- 
mized. 


To optimally help robot 1, choose P — By (77) 

the task can be optimally shared if 

F h = -\ F i and F A = - \ F l - 

and the minmium cost function is 

j ^ rprn T rp» 

— ^g r /i r h' 


It can be verified that; 

(1) the force constraints are satisfied, 

(2) the null space property holds, 


7 DESIGN EXAMPLE 

The case of three robots (each with three joints) 
transfering a point-mass payload is used to demon- 
strated the application of the strategy. Note that no ro- 
tations are involved in this case. Assume that the force 
constraints at the grasp point for robot » (i = 1,2,3) 
in the x, y and z directions are given in Newtons as 


|fW*)l < 120 - 

I F e „d. (y) I < 150 

and 

|F end, (^)l < 150. 

Since the payload is a point-mass with no rotation, A = 
E 3 and W = [F 3 E 3 E 3 ]. Hence 



’E 3 

’ Fp = \ 

'T' 

e 3 

F 

e 3 

0 

F 


where F € F 3 is computed by (44), (58) and (59), or 
(64)-(66). 

Suppose that at time 1 1 , 


|F*(«)(«i)| > 120, 

|FV 1 (y)(ti)i > 150 


|Fp,(z)(ti)| > 150. 


Then robot 1 needs help and the Ft^x/y/z) are spec- 
ified as 


F/» 


120 - \F{x) if |F(x) > 120; 
-120 - \F{x) if \T{x) < -120, 


WF / = F h + F/ 3 + F h 



= 0 


and 

(3) the equivalent control force T is guaranteed since 


A t W(F p + F;) = Ej[E 3 E 3 E 3 ] 


f Pi + F h 
F p 2 + F h 


LFp 3 + F/ 3 J 

= (Fp, + Fpz + Fp^) 

+ (F/, + F/j -I- F h ) 


= (k + ^ + ^ ) + ° 

= F. 


8 CONCLUSIONS 

The path tracking control problem of a multi-robot 
system handling an unknown rigid payload is studied. 
Based on the combined dynamic model which reflects 
payload effects, three robust path tracking control al- 
gorithms are constructed. The payload can be of any 
shape as long as its center-of-mass is known. As can 
be seen, the strategies do not require wrist force sen- 
sors, but the quantity {(xo, <£o)> (*o } 4>o)} ^ required. 
Also the matrix Si, which depends on the location and 
orientation of the i th end-effector, is needed. A vision 
system would be appropriate to obtain this informa- 
tion. 

Notice that in this work the manipulation force and 
moment constraints are explicitly considered. In some 
applications, it is desirable to limit the stress in the 


y 


i y 

' y . 



! L 




i gj 


object while manipulating it. This imposes a constraint 
on the internal forces of the form, 

F r ,(i) £ (82) 

where A,(») describes the region in which the i th ele- 
ment of the internal force at contact point j should lie. 
This region is specified as 

Aj(») = [ty (»).*?/(»')] 

where r/“(i) and are given constants. 

A similar strategy can be developed to satisfy this 
requirement. It is natural to ask if one can choose a 
value for F/ ; (i) (j € ^ 2 ) such that both (70) and (81) 
are satisfied. The answer to this question is positive if 
the constraints imposed in (70) and (81) do not lead to 
conflicting choices for Fi^i). Otherwise, the answer is 
negative. 

In developing the control strategy, it is assumed that 
each robot firmly grasps the payload through the con- 
tact point. For some advanced applications, flexible 
grasping may be required. Hence extension of the re- 
sults to the soft grasp case would be an interesting fu- 
ture research topic. Another issue worth investigating 
is the effects of load- transitions during “pick-up” and 
“drop-off” phases. 

APPENDIX 
Skew Symmetry of Ns 
It is sufficient to show that M is skew-symmetric. In 
fact since 

wo x R = R, 

it follows that 

M = ±(T? RI 0 R t To) - 2T 0 t wo X RI 0 R t T 0 

at 

- 2Tj RI 0 R T fa 

= (fjRI 0 R T T Q - T 0 RIoR T T 0 ) 

+ (T*RIoR T To - T 0 t RI 0 R T To). 

It can be verified that 

+ = 0 , 

which implies the skew-symmetry of N 6 . 
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